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Abstract 


This  paper  discusses  modeling  of  a  3-D  flexible  the  robot  which  presents  a  substantial 
flexibility  on  the  links,  and  significant  mass  on  the  tip  and  joints.  The  method  is  based 
on  Lagrangian  dynamics  and  coordinates  transform  under  the  assumption  of  mass  less 
link  and  lumped  mass  on  the  joints  and  end-effector.  This  method  is  feasible  for  a  large 
class  of  3-D  flexible  robots,  and  is  simple  so  that  it  can  be  implemented  in  a  model- 
based  real-time  control.  The  developed  model  is  of  sufficient  precision  required  for 
most  tasks  of  the  light-weight  manipulators.  The  experimental  result  has  verified  the 
model. 


Modeling  of  a  3-D  Light-Weight  Space 

Manipulator 


1.  Introduction 

Considerable  attention  has  been  directed  to  the  use  of  light-weight  manipulators  which 
provide  an  energy-efficient  motion.  Light-weight  manipulators  are  especially  feasible  for 
applications  in  space,  such  as  in  orbit  or  on  other  planets,  because  the  cost  for  launching  is 
proportional  to  the  weight  of  the  object  to  be  launched. 

Many  researchers  have  been  investigating  the  problems  of  the  light-weight  manipulators 
with  a  substantial  flexibility.  Flexible  mechanical  chains  have  been  treated  as  distributed 
mass  system  which  results  in  a  complex  model  and  is  difficult  to  control  based  on  such  a 
model.  Most  papers  are  limited  to  report  on  planar  models  with  two  or  less  degrees  of  free¬ 
dom  (DOF) [1,2].  On  the  other  hand,  most  light-weight  manipulators  with  a  substantial 
flexibility  can  be  modeled  so  that  most  of  the  mass  is  considered  to  be  concentrated  at 
joints  or  end-effectors,  neglecting  link  weight[3].  In  this  way,  modeling  and  control  can  be 
much  simplified,  and  motion  analysis  of  a  3-D  flexible  robot  is  possible. 

In  this  paper,  modeling  of  a  multiple  joints  light-weight  manipulator  with  a  serial  mechan¬ 
ical  chain  is  discussed.  This  method  is  based  on  a  lumped  model  from  which  linearized 
dynamics  equations  are  derived.  The  3-D  manipulator  that  we  have  developed  in  the 
Robotics  Institute  of  Carnegie  Mellon  University  is  composed  of  two  light-weight  links 
from  the  base  to  the  end-effector[4,5].  By  using  the  proposed  method,  the  flexible  space 
manipulator  is  modeled  as  an  example.  The  method  proposed  can  be  used  for  modeling 
any  multiple  joint  3-D  fight-weight  manipulator  as  long  as  the  configuration  is  serial  chain 
and  link  mass  is  negligible. 


2.  Modeling  Strategy 

The  purpose  of  modeling  is  to  obtain  dynamics  motion  equations  for  the  3-D  flexible 
manipulator.  Since  the  tasks  for  the  flexible  manipulator  in  space  require  a  large  motion 
within  its  workspace,  which  presents  a  significant  effect  on  the  dynamics  of  the  system, 
we  would  like  to  have  a  model  in  which  considers  a  large  3-D  motion  is  allowed.  The 
degree  of  complexity  of  the  model  depends  upon  the  required  precision  of  the  system  in 
operation.  The  model  derived  in  this  report  is  feasible  in  terms  of  compromising  between 
the  necessary  precision  and  the  resultant  complexity.  This  model  is  useful  in  the  design  of 
the  mechanical  configuration  of  a  flexible  robot,  as  well  as  the  design  of  the  manipulator 
controllers. 

The  manipulator  considered  consists  of  multiple  rigid  joints  with  actuators  and  high  gear 
ratio  drive  trains,  multiple  light-weight  links  and  an  end-effector  at  the  end.  These  compo- 
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nents  are  connected  from  the  base  ground  to  the  end-effector  in  a  serial  configuration. 
Most  flexible  robots  can  be  described  in  this  way. 

The  following  assumptions  are  made  to  obtain  a  linear  model  of  the  flexible  robot.  First, 
the  mass  of  the  light-weight  links  is  neglected,  compared  to  the  mass  of  the  joints.  Second, 
we  only  consider  the  light-weight  link  shaped  as  a  tubular  or  cylindrical  slender  beam 
which  has  the  high  tensile  and  shear  stiffness.  Therefore,  the  compliance  of  the  link  is  con¬ 
sidered  in  the  bending  and  torsional  directions,  while  the  compliance  in  the  other  direc¬ 
tions  is  neglected.  Third,  the  deflections  of  the  light-weight  link  is  small  with  respect  to 
the  length  of  the  link  so  as  to  obtain  a  linear  model.  Fourth,  light-weight  link  is  assumed  to 
be  connected  to  the  center  of  the  motor  shaft  so  that  the  size  of  the  joints  is  negligible. 
Fifth,  the  end-effector  is  assumed  to  be  rigid.  Sixth,  gravity  is  not  taken  into  account  for 
space  applications.  We  may  include  the  gravity  term  in  the  model  if  needed. 

We  define  joint  mass,  link  stiffness  in  and  around  each  axis  of  the  Coordinates  frame,  and 
consider  the  joint  positions  and  deflections  as  state-space  variables.  The  kinematics  of  the 
manipulators  is  based  upon  the  Coordinates  transform  between  the  two  flexible  links.  The 
dynamics  equation  is  derived  using  the  Lagrangian  method  and  linearization.  When  the 
variables  are  not  independent,  we  propose  to  introduce  new  variables  and  modify  the  cor¬ 
responding  dynamics  equations  so  that  the  system  motion  equation  is  not  degraded  by 
using  a  set  of  new  variables.  The  eigenvalue  analysis  is  performed  based  on  the  model. 
The  method  presents  an  effective  way  to  compute  a  large  class  of  3-D  flexible  robots. 

We  use  the  following  robot  that  has  been  developed  in  our  lab  as  an  example  to  illustrate 
the  derivation  procedure.  This  method  can  be  applied  to  any  manipulator  for  which  the 
previous  assumptions  are  valid. 

The  robot  has  a  2-DOF  rigid  rotary  joint  at  the  base  and  the  tip  respectively,  a  1-DOF 
rotary  xigid  joint  at  the  elbow,  an  end-effector  at  the  tip,  two  light-weight  links  connecting 
the  base  to  the  elbow  and  the  elbow  to  the  tip  as  shown  in  figure  1.  The  lumped  mass  is 
concentrated  at  the  elbow  joint.  The  tip  is  assumed  to  be  a  lumped  mass,  although  actually 
it  stands  for  the  two  rigid  joints  and  an  end-effector  of  the  robot  developed  in  our  labora¬ 
tory. 


3.  Kinematics 

The  kinematics  of  the  robot  is  derived  in  the  following  way.  Physical  properties,  such  as 
the  mass  and  the  length  of  the  link  are  selected  as  the  parameters.  The  variables  to  describe 
the  state  of  the  system  are  also  defined.  Two  types  of  the  Coordinates  frames  are  then 
introduced;  one  is  the  rigid  link  coordinates  frame  located  at  the  end  of  each  link  without 
the  link  deflection  and  the  other  is  the  flexible  link  coordinates  frame  located  at  the  end 
with  the  deflection[6].  The  coordinates  transform  between  the  rigid  frame  and  the  flexible 
frame  are  derived.  The  absolute  tip  position  with  respect  to  the  base  is  formulated  by  using 
the  coordinates  transform. 
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Figure  1.  Configuration  of  a  Flexible  Manipulator 


Flexible  Link 


First,  we  consider  the  following  parameters  to  describe  the  model  of  flexible  robots.  We 
denote  the  length  of  each  links  by  /,  (1  <  i  <  3),  the  mass  of  each  joint  by  mt,  (1  <  i  <  3),  the 
inertia  of  each  joint  with  the  high  gear  ratio  drive  train  by  /,  (1  <  i  <  3).  The  first  link  is 
rigid  and  for  the  second  and  third  links,  the  bending  stiffness,  Kbb  and  the  torsional  stiff¬ 
ness,  Kti,  are  considered.  The  inertia  of  the  middle  and  the  tip  are  neglected. 

Second,  we  define  the  variables  to  describe  the  state  of  the  motion  as  follows.  The  angle  of 
each  joint  is  denoted  by  0i  (1  <  i  <  3),  the  bending  deflection  in  two  axes  at  each  link  end 
is  denoted  by  vyi,  vzi  (i  =  2,  3),  and  the  rotational  deflection  at  each  link  end  as  §xi,  §yi,  §zi 
(i  =  2,  3)  are  considered  as  the  variables.  It  is  noted  that  the  variable  for  the  torsional  angu¬ 
lar  deflection  of  the  third  link,  may  be  neglected,  since  no  torsional  torque  is  applied 
at  the  tip.  However,  it  is  still  considered  as  one  of  the  variables  for  the  general  description. 
The  torque  at  each  joint  is  denoted  by  x,  (  1  <  /  <  3)  is  treated  as  a  variable. 

The  position  variables  are  referred  to  the  generalized  displacement,  i.e.,  translational  dis¬ 
placement  and  angular  displacement.  The  force  variables  are  referred  to  the  generalized 
forces,  i.e.,  torque  and  force.  There  are  thirteen  positions  variables,  three  variables  for  the 
joint  positions,  ten  for  the  deflection  of  the  two  links  (five  for  each  link).  There  are  three 
force  variables  to  describe  joint  torques.  Other  ten  generalized  forces  are  considered  to  be 
equal  to  zero.  Figure  2  shows  the  parameters  and  the  variables  of  the  3-joint  flexible  robot. 

The  Coordinates  frame  is  defined  at  each  link  as  shown  in  figure  3.  The  ith  rigid  coordi¬ 
nates  frame  is  located  at  the  end  of  the  link  i  without  deflection  of  the  link  i,  while  the  ith 
flexible  link  coordinates  frame  is  located  at  the  end  of  the  link  i  with  deformation  of  the 
link  i.  To  define  the  rigid  coordinates  frame,  any  of  the  available  methods  representing 
rigid  robot  kinematics,  such  as  the  D-H  notation,  can  be  used.  To  simplify  the  Coordinates 
transform,  one  of  the  axes  must  be  parallel  to  the  link  i  with  no  deflection.  The  ith  flexible 
frame  matches  the  ith  rigid  frame  when  the  link  i  has  no  deflection.To  distinguish  the  rigid 
coordinates  frame  from  the  flexible  coordinates  frame,  prime  /,  i\  is  used  for  the  ith  rigid 
coordinates  frame.  The  base  coordinates  frame  is  located  at  the  base  of  the  robot 
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Figure  2.  Parameters  and  Variables  of  the  Manipulator 


Parameters 

h 


Kd  -2.3 


length  of  link  i 
mass  of  joint/ 

joint  inertia  i  with  high  gear  ratio, 

/!,- :  gear  ratio 

J'mi  :  motor  Inertia  £  j 

bending  stiffness  of  link  i,  ( Kbi  =  — ) 

El :  Young’s  modulus  h 

In :  moment  of  cross  section  area  Inertia  GI 

torsional  stiffness  on  link  i,  (Kti  =  — ~~  *) 

Gj :  Shear  modulus 

In :  polar  moment  of  area  Inertia 


Variables 


Gi 

X  =  1-3 

angular  displacement  of  joint  i 

v  v« 

i  =  2, 3 

bending  deflection  at  the  end  of  link 

i  =  2, 3 

torsional  deflection  of  link  i 

§yi>  §zi 

x  =  2, 3 

angular  bending  deflection  of  link  i 

i  =  1-3 

torque  on  joint  i 

Figure  3.  Coordinates  Frame 


Figure  4.  The  Coordinates  Frames  of  the  Model 


as  the  fixed  reference.  Figure  4  shows  the  coordinates  frames  of  the  model  of  the  flexible 
robot  discussed  previously. 

There  are  two  types  of  Coordinates  transform,  the  rigid  coordinates  transform  and  the  flex¬ 
ible  coordinates  transform.  The  ith  rigid  coordinates  transform  changes  the  (i'-7)th  flexible 
coordinates  frame  into  the  ith  rigid  coordinates  frame,  while  the  ith  flexible  coordinates 
transform  changes  the  ith  rigid  frame  into  the  ith  flexible  frame.  The  ith  rigid  transform 
consists  of  the  parameters  and  the  variables  related  to  the  ith  rigid  link.  The  ith  flexible 
transform  consists  of  the  variables  related  to  the  ith  flexible  link.  The  rigid  transforms  of 
the  model  shown  in  figure  4  can  be  defined  as  follows. 


cosOj  -sin0j  0  0 
sinQj  cos0j  0  0 
0  0  1/, 
0  0  0  1 


sin02  0  -cos02  /2sin02 

0  10  0 

cos02  0  sin@2  /2 cos02 

0  0  0  1 


(1) 


(2) 


R 


2 

y 


cos03  0  sin03  l3  cos03 

0  10  0 

-sin03  0  cos03  -ZjSinOj 

0  0  0  1 


(3) 


The  ith  flexible  transforms  are  defined  as  follows.  The  first  flexible  transform,  F/  , 
becomes  unity,  while  F/  ,  is  defined  as  follows; 
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4.  Dynamics 

In  this  section,  we  will  derive  the  linearized  relationship  between  the  generalized  displace¬ 
ment  and  the  generalized  force  by  using  the  parameters  and  the  variables  defined  in  the 
previous  section.  The  dynamics  of  the  model  is  obtained  in  the  following  manner.  First, 
using  the  Lagrangian  method,  we  derive  the  dynamics  of  the  model.  Second,  the  dynamics 
equations  are  linearized  in  terms  of  the  variables  by  neglecting  the  centrifugal  and  Coriolis 
terms.  The  coefficient  of  each  variable  in  the  equations  is  assumed  to  be  constant  so  that  a 
time-invariant  linear  system  is  ensured.  Third,  the  properties  of  the  linearized  dynamics 
system  is  discussed. 

The  Lagrangian  principle  is  used  to  describe  the  system  dynamics.  In  order  to  obtain  the 
kinetic  energy,  we  consider  the  joint  inertia  with  the  high  gear  ratio  drive  train  as  well  as 
the  mass  at  the  elbow  and  the  tip  as  follows: 


\  =  1  '  S  =  2  ' 
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The  potential  energy  consists  of  the  torsional  strain  energy  and  bending  strain  energy. 


Based  on  the  kinetic  energy  and  potential  energy,  the  Lagrangian  equations  are  repre¬ 
sented  in  the  following  form. 


‘L(E.)-?L+W 

dt  dqt  dqL  dqi 


=  fi 


(11) 


The  generalized  displacement  <?,-  and  the  generalized  forced  are  defined  as  follows: 


*  =  [«1  «13]  =  [61  62  %  \  \  \  ♦«,  03  \  \  K 


(12) 


/  =  =  [v2ooooot3ooooo]  (13) 

The  Lagrangian  equation  Eq(ll)  is  nonlinear  due  to  the  second  pan  of  the  kinetic  energy, 
Eq(9).  It  is  necessary  to  linearize  the  model  so  that  we  can  obtain  the  natural  frequencies 
of  the  model.  The  first  term  of  Eq(ll)  can  be  divided  into  two  parts;  the  first  part  can  be 
linearized  by  the  second  derivative  of  the  generalized  displacement,  and  the  second 
pan  which  consists  of  the  product  of  the  first  derivative  of  the  generalized  displacement, 
<7(,  is  neglected.  The  second  term  of  Eq(ll)  is  negligible,  since  this  term  also  consists  of 
the  product  of  the  first  derivative  of  the  generalized  displacement,  qr  The  product  of  the 
first  derivative  of  the  displacement  forms  the  nonlinear  centrifugal  and  Coriolis  forces 
which  are  negligible  under  the  assumption  of  not  too  rapid  motion.  The  third  term  of 
Eq(ll)  is  linearized  by  the  generalized  displacement,  qr  In  this  way,  we  get  the  linearized 
dynamic  equation  which  only  consists  of  the  inertia  and  stiffness  term  as  follows; 


Mq  +  Kq  =f 


(14) 
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"28  = 

«3  (/3  + /2/3cOs03) 
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"33  = 

m2  +  m3 
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m3l3x 

"37 

= 

"39  = 

m3 

II 

/^2  + 

"46  = 

BIj/jCOsOj 

"48 
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£ 

0 

II 

=  /W3COS03 

"55  = 

mAx 

"57  =  m3l3xl3i 

"59  =  m3*3x 

5 

s 

II 

m3/3 

"68  =  m3^3 

"6a  =  m3*3 

"77  - 

m3l\i 

"79  =  m3*3« 

"88  = 

J3  +  m3l3 

"8a  =  m3^3 

"66  = 

m3 

"aa  = 

m3 

l2x  =  l2sinQ2 

l22x  =  l2sm®2  +  !lSm  (02  + 


1 3,  =  ,3sin83 
h,  =  <3«»®3 
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*44  =  ^3**, 


*37  =  -6*2**, 
*46  =  -612**, 
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Since  the  deflection  is  small,  the  inertia  matrix,  M,  is  not  a  function  of  the  deflection  vari¬ 
ables.  The  dynamics  equation  obtained  in  the  previous  way  has  the  following  properties: 

1 .  The  inertia  matrix,  M,  is  symmetric. 

2.  The  rigid  arm  inertia  matrix  can  be  extracted  from  the  inertia  matrix,  M.  The  coeffi¬ 
cients  of  M  for  the  second  derivative  of  the  joint  variables  forms  the  rigid  arm  inertia 
matrix  as  follows: 


mr  = 


Mn  Mn  Mxt 
Mn  M2 g 

Mxl  Mgg 


(17) 


3.  The  stiffness  matrix,  K,  comprises  the  two  link  stiffness  matrices.  The  link  stiffness 
matrix  is  a  five  by  five  symmetrical  matrix,  because  of  the  reciprocal  theorem  under 
the  assumption  of  small  deflection.  Moreover,  the  torsional  stiffness  on  the  x-axis  is 
scalar  decoupled.  The  bending  stiffness  along  the  y-axis  and  the  z-axis  is  coupled  to 
the  angular  bending  stiffness  on  the  z-axis  and  the  y-axis,  respectively.  This  property  is 
the  result  of  single  cantilever. 
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4.  The  stiffness  matrix,  K,  can  be  directly  obtained  from  the  link  parameters.  The  follow¬ 
ing  procedure  can  be  used  to  derive  the  stiffness  matrix,  K.  First,  the  coefficient  of  the 
stiffness  matrix,  K,  for  each  joint  variable  is  set  to  zero.  Second,  the  known  stiffness 
matrix  for  the  single  cantilever  is  substituted  into  each  link  stiffness  matrix.  Since  each 
joint  and  stiffness  matrix  is  decoupled  from  the  others,  the  rest  of  the  elements  are  set 
to  zero. 

5.  The  generalized  force,  x,  applies  on  the  joint.  No  external  force  is  considered  in  this 
case,  and  thus  any  deflection  on  the  corresponding  direction  is  zero. 

6.  The  dynamics  equation  can  be  divided  into  two  parts,  one  is  for  the  tangential  direc¬ 
tion  motion  represented  by  0,-,  fygj,  while  the  other  is  for  the  radial  direc¬ 

tion  motion  which  consists  of  02, 0j,  vgj,  4>y2j.  This  is  understandable,  since  the  axis 
of  the  first  joint  is  perpendicular  to  the  axes  of  the  second  and  third  joints  regardless  of 
the  manipulator  configuration. 

7.  Each  variable  may  not  be  independent.  This  will  be  is  discussed  in  the  next  section. 

5.  Variables  Constraints 

In  the  previous  section,  we  obtained  a  linearized  dynamics  motion  equation  based  on  the 
Lagrangian  method.  In  this  section,  we  will  obtain  the  natural  frequencies  of  the  model  at 
the  free  mode  where  the  generalized  forces  are  zero.  In  order  to  derive  the  eigenvalues  of 
the  model  we  would  like  to  obtain  the  generalized  eigen-matrix,  M~lK,  which  is  products 
of  the  inverse  inertia  matrix  and  the  stiffness  matrix.  However,  the  inverse  of  M  may  not 
exist,  since  each  generalized  displacement  may  not  be  independent.  The  following  is  a 
procedure  to  obtain  the  natural  frequencies  of  the  model  in  the  case  of  the  existence  of  the 
variable  dependency.  This  dependency  can  be  observed  physically  as  discussed  below. 

First  of  all,  the  angular  torsional  deflection  of  the  third  link, ^3  (Q\\) ,  may  not  occur, 
since  a  point  mass  is  assumed  at  the  tip.  This  implies  that  may  not  be  considered  as  a 
variable,  since  it  is  always  zero.  Therefore,  the  coefficient  related  to  this  variable  should 
be  simply  deleted  from  the  both  inertia  matrix,  M,  and  the  stiffness  matrix,  K.  To  be  spe¬ 
cific,  the  11th  row  and  column  of  both  matrices  are  deleted. 

Second,  the  angular  deflection  of  the  third  link  in  the  y-axis,  ^3  (^12) ,  and  the  z-axis, 
4>z3  (<713) ,  are  dependent  on  the  deflection  at  the  end  of  the  third  link  in  the  z-axis, 
vz3  (#10)  >  2°^  the  y-axis,  vy3  (q9) ,  respectively,  because  no  moment  of  inertia  exists  at 
the  center  of  the  mass  at  the  tip.  This  implies  that  the  angular  deflection  of  the  third  link 
can  be  replaced  by  the  deflection  on  the  third  link.  The  12th  and  13th  rows  and  columns 
are  deleted  in  both  inertia  matrix  and  the  stiffness  matrix.  The  9th  and  10th  diagonal  ele¬ 
ments  are  modified  as  follows: 


Kn'  - 


(*99 

(V«  -*L> 


08) 


10 


n 


Third,  the  angular  deflection  of  the  second  link  in  the  y-axis,  ^2,  is  dependent  on  the 
deflection  of  the  third  link  in  the  z-axis,  vi3  (qJ0) .  <|>  2  (4$)  is  caused  by  the  acceleration 
of  the  tip  in  z-axis,  z3.  vz3  is  also  produced  by  z3.  Therefore  the  6th  variable  and  10th 
variable  are  dependent. 

(*46\ (<?4>  +  *66*„  <*6>  )  *3  =  *aa\  (?10>  09) 

To  be  specific,  a  new  variable,  vz3  ,  is  defined  as  the  10th  variable  and  the  6th  row 

and  column  are  deleted  in  both  M  and  K  so  that  the  two  variables  are  combined  into  a  new 
variable. 


■<V*>o)+,3V,6)) 


(20) 


The  new  variable  is  defined  in  such  a  way  that  the  10th  row  and  column  elements  of  the 
inertia  matrix,  M,  are  the  same  as  before.  Using  the  new  variable,  we  modify  the  10th  row 
and  column  of  the  stiffness  matrix,  K,  as  follows: 


*44*  = 


(  *44*66 '*«)  +  *44*„' 


*66+*« 


K’  = 


*46  Kaa'^ 
"  *^*«' 

*66  *-a'r 

v  rr  _ _ 3 

aa  "  *66+*fl; 


(21) 


Forth,  the  angular  deflection  in  the  z-axis,  <|>z2  (q7) ,  and  the  torsional  deflection,  <J>x2  (q5) , 
of  the  second  link  and  the  deflection  for  the  y-axis  of  the  third  link,Dy3  (q9) ,  are  depen¬ 
dent.  4>Z2  is  caused  by  the  acceleration  of  the  tip  in  y-axis,  y,  so  are  §x2  and  t^2.  There¬ 
fore,  the  5th,  7th  and  9th  variables  are  dependent; 


*55^*2  (^5)  /3Sine3  ~  (*37^2^3)  +  *77^22  ^7)  )  -  *99<t)>3  (^9)  (22) 

A  new  variable,  x>y3' (q9r) ,  is  defined  as  9th  variable,  and  the  5th  and  the  7th  row  and  col¬ 
umn  are  deleted  in  both  M  and  K  so  that  the  three  variables  are  combined  into  the  new 
variable. 

vy3'(<79')  3X>yi(q9)  +/3 sine3$j2(?j)  +/3cos0j(j»j2(<?7)  (23) 

The  new  variable  is  defined  in  such  a  way  that  the  9th  row  and  column  elements  of  the 
inertia  matrix,  M,  are  kept  the  same.  Using  the  new  variable,  we  modify  the  9th  row  and 
column  of  and  the  stiffness  matrix,  K,  as  follows: 
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*55^77*99 


*55*77  +  +  l^cos^B^K^K^' 

,  _  _ *S5*37*99  *3cose3 _ 

^55^77  +  llwfojt-nKn  +  /3Cos2e3Af55K99' 

*55  (*33*77  -  Ar|7)  +  ATW'  (*33*77  ~  *37)  /^sin2^  +  K3iKS5K^'l^cos  0^ 

1  *55*77  +  llsm^K^K"’  +  /jcos  \KSSK„' 


(24) 


Based  on  the  four  modifications  above,  a  new  inertia  matrix  is  invertible.  Moreover,  we 
normalize  the  new  inertia  and  stiffness  matrices  in  order  to  facilitate  the  following  proce¬ 
dures.  The  modified  dynamic  motion  equations  are  as  follows: 


Mq“  +  Kq  =  x 


(25) 


rn/2sin282  + 1\ 

0 

m/sin02  +  ! 

0 

0 

'x 

0 

0 

y2  +  ml 2  +  /2  +  1  +  2/cos0j 

0 

ml  +  l+  cos03 

1  +  /COS0J 

0 

1  +  /COS0J 

m/sin92 

0 

m+  1 

0 

0 

1 

0 

0 

m/  +  /  +  cos03 

0 

m+  1 

COS0J 

0 

cos0j 

0 

1  +icos03 

0 

COS0j 

1  +j2 

0 

1 

J, 

0 

1 

0 

0 

1 

0 

0 

1  +/COS0J 

0 

COS0J 

1 

0 

1 

(26) 


0  0  0  0  0  0  0 

0  0  0  0  0  0  0 

0  0  £33  0  0  ^36  0 


K  = 


00  0  40  0  ^7 
00  0  0  0  0  0 
0  0^  0  0  K",  0 


0  0  0  K41  0  0  ^77] 


(27) 
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*33  = 


(28) 


^  kl2  *,  3' 


*36  = 
*66  = 
*44  = 
*47  = 
*77  : 
A  1 

A  2 


A  1 


6cos6, 

4/ 

A  1 

1 

A  1 

I2kl  {kl  +  3) 
42 
-18  kl 
A  2 

12  kl2 
A  2 


COS 


sin 


4  klL 


4W2  +  3 


_^3  1 

*,  +  3 


r 

V  V 

[01  02  V*  \  03  V>,  % 

,= 

ei  e2  T  T  03 

‘3  *3  -| 

T,  T,  0  0  tl  0  0  = 

X2  T3 

-iOO-iOO 

LI  2  3  J 

*.  Kk 

bi  bi 

rfto 


lx s  J- sinBj  +  sin  (02  +  03) 


/sin02+  sin03 


(29) 


(30) 


Eq(25)  is  the  time-invariant  linearized  dynamic  equation  in  terms  of  the  robot  configura¬ 
tion.  We  can  obtain  the  natural  frequencies  of  the  model  at  each  robot  configuration  in  the 
following  manner. 


First,  the  configuration  of  the  robot  is  determined  by  the  joint.  The  inverse  matrix  of  the 
new  inertia  is  numerically  obtained.  Second,  the  inverse  inertia  matrix  is  multiplied  by  the 
stiffness  matrix  to  obtain  the  eigen-matrix.  Third,  the  eigenvalues  of  the  eigen-matrix  are 
computed  and  the  natural  frequencies  of  the  system  are  square  roots  of  the  eigenvalues. 

The  natural  frequencies  can  be  used  in  the  design  of  the  robot  controller  and  mechanical 
structure  of  the  robot  in  order  to  consider  the  dynamics  of  the  robot  system. 


6.  Simulation  and  Experiment 

The  numerical  simulation  has  been  performed  based  on  the  model  discussed  above.  The 
natural  frequencies  are  obtained  from  the  linearized  dynamics  equations.  The  inertia  and 
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stiffness  matrices  in  the  dynamics  equations  are  changed  with  the  configuration  of  the 
flexible  robot  In  order  to  make  the  dynamics  equation  time-invariant,  the  small  change  in 
the  configuration  is  assumed.  The  eigenvalues  are  analyzed  at  each  configuration. 


The  parameters  in  Table  1  are  used  to  formulate  the  dynamics  equations.  These  parameters 
are  calculated  from  components  and  parts  of  our  experimental  light-weight  manipulator. 


Table  I.  Simulation  Parameters 


h 

normalized  joint  1  inertia  (gear  ratio  60:1) 

0.01342 

h 

normalized  joint  2  inertia  (gear  ratio  100:1) 

0.03728 

h 

normalized  joint  3  inertia  (gear  ratio  60: 1) 

0.01342 

m 

normalized  mass  2 

0.3846 

l 

normalized  length  of  link  2 

1.000 

k* 

normalized  torsional  stiffness  on  link  2 

0.750 

k 

normalized  bending  stiffness  on  link2 

1.000 

CO 

normalized  time 

7.631 

Table  2  shows  the  simulation  results  of  the  natural  frequencies.  The  configuration  of  the 
flexible  robot  is  selected  so  that  the  tip  moves  along  the  plane  Zg  =  0.  The  robot  motion 
can  be  viewed  as  two  types  of  motions,  the  tangential  and  radial  motions.  There  are  seven 
modes  of  vibrations  at  each  configuration.  The  first  three  modes  (f-0 )  corresponds  to  the 
rigid  mode.  The  lowest  non-zero  mode  occurs  in  the  tangential  motion.  For  this  mode,  the 
frequency  decreases  as  the  angle  of  the  third  join  increases.  The  second  lowest  non-zero 
mode  is  in  the  radial  motion.  In  this  mode.  The  frequency  decreases  slightly  as  the  angle 
of  the  third  joint  increases. 

Table  2.  Simulated  Natural  Frequencies _ 


02  [deg] 

90 

60 

45 

30 

15 

03  [deg] 

0 

60 

90 

120 

150 

mode  1  [rad/rad] 

0.00(t) 

0.00(t) 

0.00(t) 

0.00(0 

0.00(0 

mode  2  [rad/rad] 

0.00(r) 

0.00(r) 

0.00(r) 

0.0 0(r) 

0.00(r) 

mode  3  [rad/rad] 

0.00(r) 

0.00(r) 

0.00(r) 

0.00(r) 

0.00(r) 

mode  4  [rad/rad] 

3.98(t) 

2.79(t) 

2.36(t) 

2.14(t) 

2.02(1) 

mode  5  [rad/rad] 

8.25(r) 

8.25(r) 

8.26(r) 

8.30(r) 

8.38(r) 

mode  6  [rad/rad] 

13.7(r) 

12.7(r) 

11.08(r) 

10.0(r) 

7.14(r) 

mode  7  [rad/rad] 

16.6(t) 

13.3(t) 

j  2.6(t) 

12.5(t) 

12.5(t) 

t:  tagential  motion  r:  radial  motion 


The  experiment  has  been  performed  to  obtain  the  natural  frequencies  at  certain  configura¬ 
tions.  The  experimental  robot  has  five  DOF  with  a  gripper  as  the  end-effector  as  described 
in  figure  1.  The  last  two  rigid  joint  and  the  griper  can  be  considered  to  be  concentrated  at 
the  tip  as  a  lumped  mass. 


By  sweeping  the  sinusoid  torque  from  low  to  high  frequency,  the  natural  frequencies  as 
the  local  peek  of  the  sensors  readings  are  measured.  In  order  to  verify  the  experimental 
natural  frequencies  of  the  tangential  motion,  we  apply  the  torque  to  the  first  joint  and  mea¬ 
sure  the  elbow  and  tip  accelerations  in  the  tangential  direction,  while  locking  the  rest  of 
joints.  The  comparison  between  the  simulation  and  the  experimental  results  are  listed  in 
Table  3.  For  the  tangential  motion,  the  analytical  eigenvalue  is  slightly  larger  than  that  got 
from  the  experiments,  because  the  parameters  errors.  However  the  ratio  of  the  error  is 
mostly  the  consistent  to  the  others.  Because  of  unmodel  errors,  such  as  the  error  in  the  tip 
inertia,  the  experiment  has  shown  four  modes  of  the  vibration,  while  the  simulation  result 
has  only  three  modes.  The  experiment  the  radial  motion  has  not  been  performed. 


Table  3.  Experiment  and  Simulation  of  Natural  Frequencies  in  Tangential  Motion 


0?  (deg] 

56.27 

111.82 

77.64 

90.0 

03  {deg] 

62.20 

36.23  | 

25.95 

0.00 

Experiment 

Simulation 

Experiment 

Simulation 

Experiment 

Simulation 

Experiment 

Simulation 

mode  1  [rad/rad] 

0.00 

0.00 

0.00 

0.00 

0.00 

0.00 

0.00 

0.00 

mode  2[rad/rad] 

2.22(79.0%) 

2.81 

1.98(78.6%) 

2.52 

2.96(82.5%) 

3.59 

3.29(82.7%) 

3.98 

mode  3[rad/rad] 

10.3(80.5%) 

12.8 

9.06(58.8%) 

15.4 

8.31(53.6%) 

1 5.5 

14.4(86.7%) 

16.6 

mode  4[rad/rad] 

13.6 

15.4 

14.3 

We  have  numerically  obtained  the  transfer  function  of  the  linearized  dynamic  system.  The 
transfer  functions  are  defined  as  the  seven  generalized  displacements  with  respect  to  the 
three  generalized  forces  at  each  configuration.  Because  the  tangential  and  radial  motions 
can  be  decoupled  to  each  other,  we  derive  the  transfer  functions  of  each  motion.  Figure  5 
and  figure  6,7  show  the  transfer  functions  of  the  joint  torques  to  the  tangential  and  radial 
motions  in  Body-plot  at  a  certain  configuration,  respectively.  On  the  low  frequency 
ranges,  the  gain  of  the  joint  variables  has  the  second  order  slope,  while  the  gain  of  the 
deflection  variables  has  constants.  This  shows  that  the  flexible  model  can  be  treated  as  the 
rigid  model  on  the  lower  frequency  range. 

The  experimental  Body-plot  in  the  tangential  motion  has  been  obtained  at  a  certain  config¬ 
uration.  The  sinusoid  torque  on  the  first  joint  of  the  robot  is  applies  as  the  input,  while  the 
elbow  acceleration  in  the  tangential  directions  are  measured  as  the  output.  The  elbow 
acceleration  is  selected  so  that  the  first  mode  of  the  vibration  is  visible.  By  measuring  the 
magnitudes  of  the  input  and  output  at  each  frequency,  the  Body-plot  of  the  elbow  acceler¬ 
ation  with  respect  to  the  first  joint  torque,  is  obtained  as  shown  in  figure  8.  A  sufficient 
large  magnitude  of  the  input  torque  is  selected  so  that  the  stiction  in  the  joint  is  not  signif¬ 
icant.  The  experimental  results  are  similar  to  the  simulation  results. 
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Figure  5.  Body  Hot  of Tangential  Motion,  Bjkj,  vt2/xlt  vl3/xj  (Q2  =  <0  [degl,8j  =  60  [deg]) 


Figure  6.  Body  Plot  of  Radial  Motion,  B/tj,  Q3lx2,  v^Xj,  vglvj  (e2  »  60  [deg],e3  -  60  [deg]) 
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7.  Conclusion 


In  this  paper,  a  3-D  light-weight  space  manipulator  is  modeled.  By  concentrating  the  mass 
at  the  joint  and  neglecting  the  light-weight  link  mass,  the  model  of  the  flexible  robot  can 
be  linearized.  The  proposed  method  can  also  be  used  to  model  any  arbitrary  serial  config¬ 
uration  flexible  robot  when  the  link  mass  is  negligible.  The  method  is  simple  and  can  be 
efficiency  used  in  the  real-time  control,  while  it  is  of  sufficient  precision  required  for  most 
of  the  light-weight  manipulator  for  various  cases  are  performed.  The  experimental  result 
has  verified  the  derived  model. 
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